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This  paper  addresses  the  ipplication  of  filtering  theory  to  the  problem  of  (MU 
dynamic  calibration  and,  in  particular,  to  the  Carousel  VB  system.  In  tha 
calibration  procedure,  accelerometer  outputs  are  summed  over  long  time 
interval*  before  processing.  For  this  reason,  the  standard  K-B  filter  needs 
to  be  modified  as  presented  in  thus  paper.  Filter  derivation  and  calibration 
results  from  processing  real  accelerometer  data  ara  presented  herein. 


1.  INTRODUCTION 

The  Carousel  VB  IMU  is  an  all-attitude,  four- 
gimbal  inertial  platform  in  which  two  orthogonal 
gyros  and  accelerometers  are  mounted  on  a car- 
ouseling  platform  which  rotates  at  1 rpm.  The 
third  set  of  instruments  remains  inertial  along  the 
carouseling  axis.  For  a more  detailed  description 
of  the  IMU,  refer  to  Ref.  (1)  and  Figure  1.  This 
IMU  is  currently  used  in  the  T IIIC  launch  vehicle. 
The  calibration  process  extracts  optimum  esti- 
mates of  the  IMU  parameters  for  IMU  compensa- 
tion using  accelerometer  output  data. 

Because  the  measurement  data  are  summed  over 
a long  time  interval  compared  to  the  system  dy- 
namics update  cycle,  the  standard  extended  K-B 
filter  has  to  be  reformulated.  The  filter  formu- 
lation, as  well  as  filter  estimates  from  process- 
ing actual  IMU  output  data,  are  presented. 


2.  SYSTEM  BEHAVIOR  OF 
CAROUSEL  VB  IMU 

2.  1 COORDINATE  AND  TRANSFORMATION 
DEFINITIONS 

E-N-U:  An  inertial  orthogonal  system  which  coin- 
cides with  east-north-up  at  "go-inertial". 


Turret: 

<xT,  yt,zt) 

Platform: 

(X  , Y ,Z  ) 

P P P 


Orthogonal  system  fixed  to  drifting 
turret  (Z^,  along  gravity). 

Orthogonal  system  fixed  to  car- 
ousel platform.  X-Y,  gyro,  and 
accelerometers  are  referenced  to 

this  coordinate  system.  X , Y 

P P 

along  the  ideal  X,  Y accelerometer 
and  gyro  input  axes,  Z along  Z^.. 


E: 

E-N-U  —♦Turret  (3  X 3) 

T:  Turret  — ♦ Platform  (3X3) 

' cos  (0YN)  sin  (0YN) 

O' 

T = 

-sin  (0YN)  cos  (6YN) 

0 

0 0 

1. 

U) 


where  0YN  = Carousel  angle:  function  of  time  only. 


Let  >K  0,  p be  the  three  Eulerian  angles  that  de- 
fine the  turret  axes  with  respect  to  the  E-N-U 
system.  E can  be  expressed  as 

E . 

co*4»  com  • co*®  tin#  iinJ»  coM  un#  * coil  com  *tn>  tin*' 

com  - coa®  tin#  *tn4*  -*ln4t  *inf  ♦ co*®  com  «n*v  coiv 
• in®  *in#  «*m®  com  co»® 

(2) 


cu  - it#o  »*vt  mu.  ot  - oumit  un . u •!»'«  am 
111  ■ ICCtlMOM'H  «Klt  l»l 


Figure  1,  Carousel  VB  Cilmbal  and 
Platform  Configuration 
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2.2  CAROUSEL  VB  MODELING 

There  are  29  parameters  that  characterize  the 
performance  of  the  tMU.  They  are  gyro  drifts  (3), 
gyro  unbalances  (9),  gyro  misalignments  (4),  gyro 
scale  factors  (2),  accelerometer  biases  (3).  accel- 
erometer scale  factors  (3),  and  misalignments  (5). 

The  drift  rates  along  the  turret  axes  (X^.,  Y^,,  Z^,) 
are  composed  of  applied  torques,  gyro  drifts,  and 
unbalance  drifts.  Note  that  all  drifts  are  resolved 
into  the  turret  system. 


£ = local  gravity  vector  in  E-N-U  system 
(function  of  time  only  due  to  earth 
rotation) 

The  sensed  acceleration  as  measured  by  t’ie 
accelerometers  can  be  expressed  as  follows: 


z a b » [KHvI  [Tj  [g]  [E)&  | (4) 


where 
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- gyro  misalign- 
ment matrix 
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= reciprocal  of  accel- 
erometer scale 
factors 


= z -accelerometer  mis- 
alignments matrix 


and  T is  as  defined  by  Eq.  (1) 
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= applied  torque  (along  x,y  gyro 
input  axes);  functions  of  time 


L 0 J only 
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= gyro  unbalance 
matrix 


R = 


lr 


- gyro  drifts 


T = Carousel  matrix  [see  (1)1 

E - 3 X 3 transformation  matrix 
[see  Eq.  (2)} 


[T]  = Carousel  matrix  [see  Eq.  (1)] 


= x,y  accelerometer  mis- 
alignments matrix 


£ = gravity  vector  in  E-N-U  coordinates 

The  integrating  accelerometer  output  over 
a fixed  time  interval  is  simply  the  integral 
of  the  "measured"  sensed  acceleration  over 
that  interval.  This  output  is  used  as  the 
"measurement"  data  for  the  filter. 

The  components  of  E are  functions  of  the  Euler 
angles  0,  p.  The  Euler  angles  are  governed 
by  the  following  set  of  differential  equations: 

= (“xT  ,tn*  + “YT  co,*)/*in® 

0 = cos p - <jyT  sinp  (5) 

p = sinp  cosfl  t-  Uyy  cosp  cosO)/ 

(sinO)  + 

where  Uy-p  are  as  defined  in  Eq.  (3), 


3.  FILTER  FORMULATION 

The  "states"  of  the  filter  are  the  29  parameters 
to  be  estimated  and  the  Euter  angles  which  define 
the  orientation  of  the  IMU  (turret  system).  Equa- 
tion (5)  describes  the  dynamics  of  the  attitude;  the 
parameters  are  constants  with  white  Gaussian- 
state  noise.  Equation  (4)  is  the  measurement 
equation  for  the  filter.  Equations  (4)  and  (5)  are 
then  linearized  for  the  purposes  of  computing  fil- 
ter gains. 

The  linearized  system  can  be  described  as 

( x - <p  x . + u 

) ~n  n~n-1  (6) 

) z = H x + v 
( — n n — n — n 


x = states  (32-dimensional  vector  contain- 
— n 

ing  29  parameters  and  3 attitude  errors) 

z - measurements  (3-dimensional  vector) 

— n 

u = state  noise 
— n 

v = measurement  noise 
— n 

Pn  - state  transition  matrix  over  one  cycle 
(1  sec) 

Hn  = measurement  matrix  relating  accel- 
erometer counts  (velocities)  to  the 
states  at  each  cycle  (1  sec) 


E[u  u 1 = 6 Q 
L=n  — m ' nm  n 

Efv  v'  ] = 6 R 
1— n — m ’ nm  n 

Both  pn>  Hn  are  updated  over  1-sec  intervals. 

In  the  factory  calibration  problem,  the  acceler- 
ometer data  are  processed  once  every  135  steps 
(seconds)  with  the  accelerometers  accumulating 
counts  over  the  entire  135  sec.  Therefore,  the 
system  model  can  be  written  as  follows: 


-N  = *N  — N- 1 + -N 
2n  = HN  -N-l  + -N 


HN  rHn*nVr"  0n-k+l 
+ Hn-  1 0n-l444  *n-k+l 


+ ...  + H . , | ift  , , . 

n-k+1  ^n-k+l 


U*  = n +6  u 4 + , 
— N — n rn  — n-l 


* ^n  ^n- 1 ' ' * ^n-k+2  ^n-k+1 


V„  = H u + (H  0 + H .)  u , 

— N n — n n n n-l  —n-l 

+ (H  0 0 . + H ,0  , + H ,)  u «+.  .. 

n ’r.  rn-l  n-l  ’n-l  n-Z  -n-2 


+ (Hn  *n 

+ H .0  .0  ,...0  ... 

n-l  n-l  n-2  n-k+1 

n-k  + 1 — n-k  — n —n-l  — n-k  + 1 

Each  N step  is  135  sec,  whereas  each  n step  is 
1 sec.  The  state  and  measurement  noise  terms 
U^j  and  are  no  longer  uncorrelated.  The  cor- 
relation functions  become 

* Vl  Q„-3'"n*n*n.l  * "n-1  Vi  * ’W 

4 *n  °n*1  ‘ ‘ * ^n-k*2  ^n-k*l^n  V * * °n-k*Z 

*H„.i  V.---Vw*---‘h„.i.m’’  (to 

q;  ^;»Ni-o„4*nQ„.t*;  *••• 

‘ ®n  Vl  Vk*2  Qn-k*l  *n-k  *Z' ' 1 *n- I °n  (11) 

RN  K[v;  y-'l  R„*V, Rn-k-l 

4"n  °n  4 <"n  *n  4 "n-l*  ^n-  l**'n  *n  * * V l'* 

‘•••4,Hn  ♦n*n.f  -*n-k.Z  *Hn-l  Vr> 

Vk*Z  1 - * ”n-k.l’  °n-kM 

mn*nVf  Vk*Z  'Vk.l'’  <12> 


where 


*N  r *n  ♦n-l444  Vk+1 


■3' 


with 


Let 

— N/K  ' Ef— n!Z1  * Z2 Zv) 

PN  = EtQ?f;  - BN/n’  (-N  * -N/N*’! 

Given  the  system  of  Eq.  (2),  the  filtering  equation* 
can  be  derived  as  follows; 


KN  * **N  PN-1  HN  + MN> 

tnlVi"!'  + rn1*‘  <*B) 

4 *5* 

Kn  is  the  filter  gain  with  and  RN  defined  in 
Eqs.  (10),  and  (12),  respectively. 


-N/N  " E(2SnIZ1’ * • • '-N- J 

* e12?nI-N  * HN  -N-l/N-i'  (13* 


Let 


The  covariance  update  equations  become 

pn  » EfcxN  - *N/N>  (XN  - xN/N)' 

but 


— N 1 — N ' VN-:-N-l/N-l 
Then  Eq.  (13)  can  be  written  as 

— N/N  = ^N/N-t  + Ef-N  — N^  EfZN  — N^  * — N ,14) 
But, 


Ef-N  -N^  E^0N-N-1  + -N* 

<HN(*N-1  -£n-1/N-1)+2n}'1 

**nVihn  + ecu*  V*'j 

r *N  PN-1  «N  +MN  ,15) 

* 

where  is  as  defined  in  Eq.  (10). 

Furthermore, 


e[|n1n1^  EHH^N-i  * *n-i/n-i>  - vj} 

fHN*-N-l  '-N-l/N-l)  + -N^ 
' HN  PN-  1 HN  + E^N  -N  ^ 


= hn  pn-i  hn  + rn 


(16) 


Combining  Eqs.  (14),  (15),  and  (16),  the  filtering 
equation  can  be  written  as 


-N/N  ' 0N-N-i/N-l 


+ KN^N  * HN -N-l/N-1^  <l7) 


a >jt  qr  * 

-N  ' -N/N  = *N-N-1  + — N ‘ (0N -N-l/N-1 

+ KN^HN(-N-1‘-N-1/N-1)+-N  W 


•*PN  r(«N 


KN  HN)  PN-1(0N  ' KN  HN,f 


+ °N  + KN  *'N  "N 


r-Km  + mn  + M*'  (19) 


where  Q^,  R^  are  as  defined  in  Eqs.  (10), 
(11),  and  (12).  respectively. 


Equations  (17),  (18),  and  (19)  constitute  the  com- 
plete set  of  filtering  equations,  keeping  in  mind, 
in  Eqs.  (7)  through  (12),  that  the  subscripts  n are 
t-sec  steps;  the  subscripts  N are  135-sec  steps. 

4.  FILTER  PERFORMANCE 
Plots  of  filter  estimates  of  representative  IMU 
parameters  are  shown  in  Figure  2.  The  data  were 
taken  on  5 June  1972  from’ Carousel  V IMU  pro- 
duction unit  No.  2.  The  abcissa  of  the  plots  is  in 
cycles,  where  each  cycle  is  equivalent  to  2.2b  «r.ir> 
of  real  time.  The  criteria  for  filter  performance 
were  the  convergence  of  filter  covariance  and  the 
measurement  residual.  The  residuals  were  un- 
biased and  of  low  magnitude  (about  0.  37e  of  mea- 
surement magnitude). 

5.  CONCLUSION 

The  optimum  filter  derived  in  this  piper  prod.*;;,! 
optimum  IMU  parameter  <‘*a,.l,nates  and  showed 
shorter  c";-..„rgence  time  than  suboptlmal  filters. 
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